#pragma once

#include "gcode/gcode_cmd.h"

typedef enum{
    MotorIdle = 0,
    MotorDowmMove,
    MotorUpMove,
}MechArmState_t;

typedef enum{
    MotorStop = 0,
    MotorRunning,
}MotorState_t;

typedef struct{
    MechArmState_t MotorRunState;
    MotorAxis_t MotorAxis;
    MotorState_t MotorState;
} MotorPosState_t;

typedef struct{
    MotorPosState_t MotorPosState[AxisNum];
    double CurrentPos[AxisNum];
    double LastPos[AxisNum];
    MotorState_t MotorState[AxisNum];
}MotorSysState_t;

void MotorCtrl_task(void *pvParameters);
